CLAIMS 



1 1 . A position detection apparatus that detects the position of a moving object, said 

2 position detection apparatus comprising: 

3 an image acquisition device that acquires an image of the forward field of view of 

4 said moving object, 

5 a distance image acquisition device having the same field of view as said image 

6 acquisition device that acquires a distance image simultaneous to acquisition of an image 
T by said image acquisition device, 

8 a characteristic point extraction device that extracts respective characteristic points 

9 from the images of at least two consecutive frames, and 

TO a reference characteristic point selection device that calculates the amount of 

T 1 displacement of a position between two frames of a characteristic point extracted by said 

TZ characteristic point extraction device based on said distance image, and selects a 

1 3 reference characteristic point for calculating position according to said amount of 

"1 4 displacement. 

1 2. A position detection apparatus that detects the position of a moving object, said 

2 position detection apparatus comprising: 

3 an image acquisition device that acquires an image within the forward field of 

4 view of said moving obj ect, 

5 a reference point determination device that determines a reference characteristic 

6 point to serve as a reference during movement of said moving object based on an image 

7 obtained from said image acquisition device, and 

8 a position detection device that detects position by substituting self-movement 
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control and the observed amount of said reference point into an extended Kalman filter. 



1 3 . A position detection apparatus that detects the position of a moving object, said 

2 position detection apparatus comprising: 

3 an image acquisition device that acquires an image of the forward field of view of 

4 said moving object, 

5 a distance image acquisition device having the same field of view as said image 

6 acquisition device that acquires a distance image simultaneous to acquisition of an image 
S by said image acquisition device, 

! jg a characteristic point extraction device that extracts respective characteristic points 

from obtained images, and 
TO a reference characteristic point selection device that compares pre-stored object 

1 information with extracted characteristic points, and considers those characteristic points 

ll 2 having a high correlation to be known characteristic points that are used as reference 

>1 3 characteristic points for calculating position. 

1 4. The position detection apparatus according to claim 3 wherein, said characteristic 

2 point selection device updates said object information by determining the relative 

3 relationship between unknown characteristic points and known characteristic points in 

4 an image in which characteristic points considered to be known are present, and storing 

5 said unknown characteristic points as known characteristic points. 

1 5. A position detection apparatus that detects the position of a moving object, said 

2 position detection apparatus comprising: 

3 an image acquisition device that acquires an image of the forward field of view of 
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4 said moving object, 

5 a characteristic point group extraction device that extracts a characteristic point 

6 group in said image, and 

7 a position detection device that calculates position by correlating and storing 

8 multiple characteristic point groups in an image pre-obtained with said image acquisition 

9 device with positions at which said characteristic point groups are obtained, and 

1 0 calculating the correlation between a characteristic point group of a newly obtained 

1 1 image and pre-stored characteristic point groups. 

1 6. A position detection method that detects the position of a moving object, said 

2 position detection method comprising: 

3 an image acquisition process in which an image of the forward field of view of 

4 said moving object is acquired, 

3 a distance image acquisition process having the same field of view as said image 

6 in which a distance image is acquired simultaneous to acquisition of said image, 

7 a characteristic point extraction process in which respective characteristic points 

8 are acquired from the images of at least two consecutive frames, and 

9 a reference characteristic point selection process in which the amount of 

1 0 displacement of a position between two frames of a characteristic point extracted in said 

1 1 characteristic point extraction process is calculated based on said distance image, and a 

1 2 reference characteristic point for calculating position according to said amount of 

1 3 displacement is selected. 

1 7. A position detection method that detects the position of a moving object, said 

2 position detection method comprising: 
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3 an image acquisition process in which an image within the forward field of view of 

4 said moving object is acquired, 

5 a reference point determination process in which a reference characteristic point to 

6 serve as a reference during movement of said moving object is determined based on said 

7 image, and 

8 a position detection process in which position is detected by substituting 

9 self-movement control and the observed amount of said reference point into an extended 

1 0 Kalman filter. 

1 8. A position detection method that detects the position of a moving object, said 

2 position detection method comprising: 

3 an image acquisition process in which an image of the forward field of view of 

4 said moving object is acquired, 

5 a distance image acquisition process having the same field of view as said image 

6 in which a distance image is acquired simultaneous to acquisition of said image, 

7 a characteristic point extraction process in which respective characteristic points 

8 are extracted from obtained images, and 

9 a reference characteristic point selection process in which pre-stored object 

1 0 information is compared with extracted characteristic points, and those characteristic 

1 1 points having a high correlation are considered to be known characteristic points that are 

1 2 used as reference characteristic points for calculating position. 

1 9. The position detection method according to claim 8 wherein, said characteristic 

2 point selection process updates said object information by determining the relative 

3 relationship between unknown characteristic points and known characteristic points in 
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4 an image in which characteristic points considered to be known are present, and storing 

5 said unknown characteristic points as known characteristic points. 

1 1 0. A position detection method that detects the position of a moving obj ect, said 

2 position detection method comprising: 

3 an image acquisition process in which an image of the forward field of view of 

4 said moving object is acquired, 

5 a characteristic point group extraction process in which a characteristic point group 

6 in said image is extracted, and 

7 a position detection process in which position is calculated by correlating and 

8 storing multiple characteristic point groups in an image pre-obtained in said image 

9 acquisition process with positions at which said characteristic point groups are obtained, 

1 0 and calculating the correlation between a characteristic point group of a newly obtained 

1 1 image and pre-stored characteristic point groups. 

1 1 1 . A position detection p rogram for detecting the position of a moving obj ect, said 

2 position detection program comprising performing by computer: 

3 image acquisition processing in which an image of the forward field of view of 

4 said moving object is acquired, 

5 distance image acquisition processing having the same field of view as said image 

6 in which a distance image is acquired simultaneous to acquisition of said image, 

7 characteristic point extraction processing in which respective characteristic points 

8 are acquired from the images of at least two consecutive frames, and 

9 reference characteristic point selection processing in which the amount of 

'I o displacement of a position between two frames of a characteristic point extracted in said 
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1 1 characteristic point extraction processing is calculated based on said distance image, and 

1 2 a reference characteristic point for calculating position according to said amount of 

1 3 displacement is selected. 

1 1 2. A position detection program for detecting the position of a moving object, said 

2 position detection program comprising performing by computer: 

3 image acquisition processing in which an image within the forward field of view 
.. 4 of said moving object is acquired, 

5 reference point determination processing in which a reference characteristic point 

6 to serve as a reference during movement of said moving object is determined based on 

7 said image, and 

8 position detection processing in which position is detected by substituting 

9 self-movement control and the observed amount of said reference point into an extended 

10 Kalman filter. 

1 13. A position detection program for detecting the position of a moving object, said 

2 position detection program comprising performing by computer: 

3 image acquisition processing in which an image of the forward field of view of 

4 said moving object is acquired, 

5 distance image acquisition processing having the same field of view as said image 

6 in which a distance image is acquired simultaneous to acquisition of said image, 

7 characteristic point extraction processing in which respective characteristic points 

8 are extracted from obtained images, and 

9 reference characteristic point selection processing in which pre-stored object 

1 0 information is compared with extracted characteristic points, and those characteristic 
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1 1 points having a high correlati on are considered to be known characteristic points that are 

1 2 used as reference characteristic points for calculating position. 

1 14. The position detection program according to claim 1 3 wherein, said characteristic 

2 point selection processing updates said object information by determining the relative 

3 relationship between unknown characteristic points and known characteristic points in 

4 an image in which characteristic points considered to be known are present, and storing 

5 said unknown characteristic points as known characteristic points. 

1 1 5 . A position detection program for detecting the position of a moving obj ect, said 

2 position detection program comprising performing by computer: 

3 image acquisition processing in which an image of the forward field of view of 

4 said moving object is acquired, 

5 characteristic point group extraction processing in which a characteristic point 

6 group in said image is extracted, and 

7 position detection processing in which position is calculated by correlating and 

8 storing multiple characteristic point groups in an image pre-obtained in said image 

9 acquisition processing with positions at which said characteristic point groups are 

1 0 obtained, and calculating the correlation between a characteristic point group of a newly 
■ 11 obtained image and pre-stored characteristic point groups. 



